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PROBLEM TO BE SOLVED: To provide a lane follow-up 
control device for a vehicle capable of allowing the 
steering intervention of a driver while maintaining high lane 
follow-up performance. 

SOLUTION: This lane follow-up control device for the 
vehicle is provided with a controller 8 for outputting a 



^&a*H ^Stftcontrol command to a motor 5 provided at a steering 
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mechanism by feedback control. The controller 8 is 
provided with a steering angle friction compensating part 
83 (a disturbance torque compensating part) for 
compensating disturbance torque inputted to the steering 
mechanism, and a feedback coefficient of the controller 8 
is set on the assumption that there is no steering 
disturbance. 
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* NOTICES * 

JPO and INPIT are not responsible for any 
damages caused by the use of this translation. 

1. This document has been translated by computer. So the translation may not reflect the original 
precisely. 

2. **** shows the word which can not be translated. 
3.1n the drawings, any words are not translated. 



CLAIMS 



[Claim(s)] 

[Claim 1]A self-vehicles relative position detection means which detects a relative position of self- 
vehicles to a target lane. 

A steering desired value calculating means which computes steering desired values, such as a target 
steering angle for deriving self-vehicles to a target lane, and target steering angle speed, based on 
detection of a relative position. 

A steering actual value detecting means which detects steering actual values, such as an actual 
steering angle and actual steering angle speed. 

A steering mechanism which steers either [ at least ] a front wheel or a rear wheel. 
A steering control means to output a control command to a steering actuator provided in said 
steering mechanism by feedback control which coincides said steering actual value with said 
steering desired value. 

It was a lane following control device of vehicles provided with the above, and a disturbance torque 
compensation part which compensates disturbance torque inputted into a steering mechanism was 
provided in said steering control means, and a feedback coefficient of a steering control means was 
set as it based on assumption that there is no steering disturbance. 

[Claim 2]In a lane following control device of the vehicles according to claim 1, said disturbance 
torque compensation part in the same direction as a steering direction. An observer which considers 
it as a steering friction compensation part which computes a control command based on a steering 
friction assumption value with a constant size, and presumes quantity of state of vehicles for said 
steering control means from input and output of a system, A regulator which computes feedback 
control instructions before compensation based on quantity of state of vehicles, A lane following 
control device of vehicles considering it as a means which adds a control command based on a 
steering friction assumption value to feedback control instructions computed without said steering 
friction compensation part's having constituted and assuming steering friction, and is made into the 
control-command last value. 

[Claim 3]In a lane following control device of the vehicles according to claim 2, said steering friction 
compensation part, A lane following control device of vehicles considering it as a compensation part 
which performs amendment which enlarges said steering friction assumption value, and computes a 
control command based on a steering friction assumption value after amendment when meandering 
occurs on vehicles during a run by lane following control. 

[Claim 4]A lane following control device of vehicles establishing the 1st meandering decision means 
judged to be meandering of vehicles when a change cycle of numerals of a yaw rate detected by a 
yaw rate detection means is beyond a preset value in a lane following control device of the vehicles 
according to claim 3. 

[Claim 5]A lane following control device of vehicles establishing the 2nd meandering decision means 
judged to be meandering of vehicles when change of other physical quantity caused by change of a 
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yaw rate is detected in a lane following control device of the vehicles according to claim 3. 
[Claim 6]In a lane following control device of the vehicles according to claim 2, said steering friction 
compensation part, A lane following control device of vehicles considering it as a compensation part 
which performs amendment which makes said steering friction assumption value small, and 
computes a control command based on a steering friction assumption value after amendment when 
hunching of a steering angle occurs during a run by lane following control. 

[Claim 7]A lane following control device of vehicles establishing a steering hunching decision means 
judged to be hunching of a steering angle with a time average of an absolute value of steering angle 
speed being large in a lane following control device of the vehicles according to claim 6. 
[Claim 8]In a lane following control device of the vehicles according to claim 1, said disturbance 
torque compensation part in the same direction as the feedback control instruction direction of the 
preceding paragraph. An observer which considers it as a steering friction compensation part which 
computes a control command based on a steering friction assumption value with a constant size, 
and presumes quantity of state of vehicles for said steering control means from input and output of 
a system, A regulator which computes feedback control instructions before compensation based on 
quantity of state of vehicles, A lane following control device of vehicles considering it as a means 
which adds a control command based on a steering friction assumption value to feedback control 
instructions computed without said steering friction compensation part's having constituted and 
assuming steering friction, and is made into the control-command last value. 

[Claim 9]An observer which presumes quantity of state of vehicles for said steering control means 
from input and output of a system in a lane following control device of the vehicles according to 
claim 1, A regulator which computes the control-command last value which is an actuator input 
based on quantity of state of vehicles constitutes, A lane following control device of vehicles 
considering it as a means made into a feedback term in a regulator which negates disturbance 
torque which presumed disturbance torque inputted into a steering mechanism by said observer, and 
was presumed by observer in said disturbance torque compensation part. 

[Claim 10]A lane following control device of vehicles providing a limiting circuit which restricts a size 
of a disturbance torque point estimate which is one of the outputs from said observer between an 
observer and a regulator in a lane following control device of the vehicles according to claim 9. 



[Translation done.] 



http://www4.ipdl. inpit.go.jp/cgi-bin/tran_web_cgi_ejje?atw_u=http://wvvw4 9/16/2008 



9 



(l9)H#H#ff/r (JP) 02) 18 4# B^F & ^ (A) 



#^2002-29437 
(P2002-29437A) 
(43)^SB ¥l£l44p 1£29B (2002. 1.29) 



(51) IntCL 7 
B 6 2 D 6/00 
5/04 

// B6 2D 101:00 
113:00 
117:00 



F I 

B6 2D 



6/00 
5/04 
101: 00 
113:00 
117:00 

m?mv>mo ol (^15 h) 



r-73-r(##) 
3D0 3 2 
3D0 3 3 



(21)ffig#^ 


!&K2000-212628(P2000-212628) 


(71)ffig?A 


000003997 










(22>asa 


¥*K12¥ 7 £ 13 B (2000. 7. 13) 










(72)3gW# 


■am 
































#^;nm«is#f>^jiiK^:"ir2#ffi b£ 














(74)ttSA 


100105153 








#a± su* ff wi«) 











(54) [^W<75^^3 *p©*«iii^i?se 



(57) mm 

nun m^wm&vi&mzwnL^ f^/s© 

;p**»«t*iiefc7y*->3:/«fll»8 3 wah;u 
^MMSP) fro, 3yFn-78©7^-hv<! 

/Co 




tfiSEfi 



3. 









83 



(2) 



1 



ftBfl 2 0 0 2 
2 



2 9 4 3 7 



mtses ^nausea jsg§o»i6*isffl%«aji- s »ne 
gout, l < ttano^a < sxf7 u 

iME»iieiiBffi*i(isa«tea«fiiti:--a*^:* 7 ^ - f 

^hfi^^mmtm^iYJimm^m^. fro, at 
ummzi i mmowmm mm.ummm 20 
nm mffe? y * * 3 ymmmt u 

y * s/ 3 L*^?Wffl£ftfc7 w - F/W 
ff(ffc»i5te«5fftf»4 buESS67 y * > 3 

X«SHfi£*t < "TStflEfcfTl^ M jE&©»IE7 'J * 

~>3 >«^ffit»^< ieowji^jf a-r*a«api: tfc 

% 1 *fr«»r#a*WJfcc k*«F«k-rs*MO*» 



[|S*S7] »*JS6IBtt©$P50«»ififie#J»*B 

fr^iS] i: n c^[pjt% *t $ ^-^oawe7 y * *> 3 > 

(ggPkU 

k, IW2!*K7y^'>3>*f«aJt«J:0«fi!tU 1§867 
y ^ S/ 3 >*SU£ L^v^f^ttl $ nfc 7 -C - F / < v * ftJ 

spffi^K, ^7 y * fa yiutfitgo* < siwa^* 
imwM 9 ] 1 mmvmmmm&mmmw 
«s«£'r*5i-7*if-/^k, smottiiateg^tT* 

1 0 ] 9 eie o*M®*«Bit£«w» « 

[0 0 0 1] 

mu&mzim loo f v^^^jt^A^fF^^^/c 



(3) 

3 

[0 0 0 2] 

Hlf5- 5 0 9 3 2W£mtzmm<Dt><Dff$QZ> 

[0003] c<D&mic&. m&tf-yicft-si&M 

[0 0 0 4] 

[»B3WJ!P»LJ:5i:"r*WB UpL&#6» £©£ 
trmm<DWc&&LT\,*Ztc#>, F57/*©:n-AtfLo* 

ALo~e>l^®#}f dtV^. 

[0 0 0 5] ilOF^IWtSftft, 8Wfr9--#£© 
l67*f-ax-*©Aa*S8K^ai»S'*7 l i*©A;b 30 

[0006] **5Wtt±isaHHfc»a LT&2ftfck© 

Loo, Fv-r^©SI6^A^g-r5Ci:A^T*tS* 40 

pfo*«Ba«£iiiijwsH*a«"r « c * 

[0 0 0 7] 

<fc»©«HifcS-3#» &wm*ummm£wm-t&ittb 
< imn<D'p% < t t>-i5*mm-z>XT7 u 7 50 



#Pffl2 002-29437 
4 

&t*miittt<DW»zamM®mzi3»T* mam 
titrn'mmc xf7 u y9mm^xtst^nn, ya, 
i?*&mtzft$Lh)i>*mm®*m. fro, metm 

[0008] n*m 2 E«o«WT?tt, is*« 1 safe© 
JMbSnafcniijErrtnf, ***ff-£©*i67y 

->3>«fll95fcU KUBIilKlBltP^a*, 77x2>©A 

1- ^ u- * t , Huie#)ie7 u * 3 7jf««fc ct 

OflltfU *M67U^'73 7£SJtL*^T*Jiai;£ftfc 
7 Y - -y * Mflffiftc . JSW67 "J * 7 3 

sox mmttttixwmmwmmtts^Ett t 

[0 0 0 9] B9*£3e«©fSfiirCtt» II*JI2!S®CD 

vpiowttiifaeMt^VK: *$v -»t % tuis^7 u * 73 

7*f $fiii(j£«(J»(c J: SjEffffcWEtefTtf 

fg* Lfci§£, fuf2*£lf£7 U ^ 73 7«£ffl**t < f 

^ «iE*fTV\ sti0£©sMe7 * 7 3 ymii.micm-3 

[0 0 10] M*84Gtt©Rlfil*a. »«a3E«© 
•M©$»iiflei6lffliSllh:*v^T, 3-77 h^W^g 

[001 1] »*«5isiccDfg^T'«, mMmmmv 

$W©i£ff WW -T S 9 2 ffifffiJBf #S^rgtt c 

[0012] m&m6%zm<D%fflx-it. mxm2mm<D 

y^m^Zs mmim&Mwiz£z>iE.fiwm&ft<D^y 
f-yftmsz Lfcm-ets mm&y u ^ 7 a 7«£it* 

/Jn$ < f S»iE*fTV\ ff IE^©^fi67 U ^73 7S^ 

[0 0 13] »*S7E«©RWT?tt, ^*«6I2^© 
©i^HV^tf* t v c i: ^ t o TlftKft ©^ v f-7 9 1 

pmt%mm>^y*y9%m^m*miftcc tzimt 

[0 0 14] »*^8E«©«W?tt, ffi^S 1EK© 



5 

»j&^*j»ia-rsjiM67U^^3>««sfcu mess 
£1-3*7^-;^ *P5©tti8*fcS"3s mmmoy 

j-Y*vZ%Wft^*nmz>\s¥3.V-Z£. ME 
HI67 U * > a «fc D Itrt U *E7 U * f 3 

y*^L4v^»*ffl**i;fe7Y- F^y ^filfflU^ 

[0 0 15] H*fi9l3*©«Wett, SI#5lE«© 
«iii50*fiBifle*iJ«i«HK:*^T» ffiEiMgftJflP^gt 

l, me* ^if-^t * oxf7'jy y*«tK:A*«n 

Sfla h;l>* *8t£U «MEflahJl/*tt«»*, *7 

-*rt©7*- F/<* *3t£f Lfcc 

[0 0 16] 3ft#£l OE*©«WCtt, »$59£tt 
©$ffi©<iigiiftf|Pj$g§fc*5^-t\ iwE*7if-^fr 
<b<D&ti<D i 

[00 17] 

*5<^T, ffl*KfcH©ttUiK:g-3t, s$if*gg$&£ 

k/^ ^w»fc«fe d xt7 u yfmmicwtifbtitc 

tm.%. LTS£*ftfc7 Y - F/Vy ^ftat n VtctbV 



(4) WPB 2 0 0 2 - 2 9 4 3 7 

6 

tt, 7-f- F^v^«»*'hS<r*ilt«<1?#, a> 

T*£5©T*&3<, 
10 [0 0 1 8] »*«2EK©»WtfeoTH:, flahJl/ 

«R»iflifcBi;36rift^ **£#-£©» 

©Affl*fr6>3iM©t^££*i£'f3*7+f-Ai:, $ 
H©mi«^S^tM{«lu©7 - F/S-y 

t <fc 9 «J«S n, llttlHfP^gt* 5 its m&7 V9*sa 

>*asba^-eiwi«nfc7 F^-y 
aw67 u ^ 3 >«siats^ < mmmfitzimz. k 

■pt, ^yif-^fci/^au-^kiise*©**^ s 
167 y * 3 fliau^iiiiq-r § ^ a ®#^iifiic©^ 

>»*7 -r - F7 * 7- K-e»«-r*iw»»©*ittfc4 

[0 0 19] ai*«3EK©f8^ta5oTtt, «K7U 

30 *$<-raaiE«<fitotu MiEa©«K7y^s/ a>a 

#r s fc*R7 y * -> a yssfi©*7 y ^ s/a >a 
©iixm«¥$ «*>©©> fi^tt^fiT-rsttiRieafesfc 
^ H/-F*7*#*TSS^*n« 0 o$y, $m© 

«fwas SIS7 y * s/ 3 >s^fii*^:# < 
40 u^y^s/avfcis^t, *pi©iefT*^ii*6nfe*« 

[0 0 2 0] Sra&S4E«©«IBfc&t>TI4, ffi l tefr 
WW^SEfev^T, 3-WHW»acj;!)«HJ2n 

fkfc^3¥«4WI«fcJ:0x 5mtcJM67yd''>3> 

[0 0 2 l] gS#S5E«©5EWCa6oTti, ^2^f 
50 WW^Sfc*V^T, 3-Wh©2fttJ:oT5l#fiC. 



7 

VmztiZo £oT, 0OAti\ HO^a^S«BE 

[0 0 2 2] »*«6ffi«0»l«t*oTtt, SM67U 
773 7*MM$li:*VT* *M]ifj£jHtPlcj;«j£ffit)l<: 
ttl6ft©Mi/^>w«4Lfc*^ 8te7y 7*7a 7 

Mfem*'bz < r **jE3Wr*Jtu siE»oiMe7 y 7 

n-5o -rftto^s ^fcS£*ft3j«e7y*->3>'«£ 
<i#, *£ t trs i:^7 y 7 7 3 ymfemvmy v 7 

7 3 y'NCiR^tt^S 5 1, ©«D, S3ttt*«fiT LUMP} 

»Jte7U* 73 7S^ffi£/J\S <-fS« 
iBSfr 5 c fc -P. £867 y * 7 3 7SSffi*^lM67 U 
77 3 >tifio*f , «M6ftO/N7f-7^ft^piL6nfc* 

[0 0 2 3] SlS*^7E«©»WtSoTH:, 1M&\7 

067 U 773 7&£ffi©MiEtf&g&JglieM7^77*£ 
[0 0 2 4] W*]l8|2mOfl^}cSoT« % ft&hfr 
^[pJT\ A* 2 #-£©81067 U 773 yg£{Ifcg-3 

< Mttifift&fftitrs JME7 y 7 7 3 yfi«gp fc ? 
my y 773 7«««pt «t o»**ti % »Kiw«i#a^ 

JM67U 773 >*ajBbftv»-pJ|[ffl*tife7-f 
- K/Vy 7*J»jfrfrfc, Jgfe? U 7 73 7SSffifcS^J 

< iftiaBg^*ftJ* fcSI8PJg^a»ffi^JM67 7 f-a x- 

ti$#©£3;T\ *M67y 773 7«flWP%i6ipf*i: 

y773>SSffi^t<T5*liE^?T9Cf:«:<, $ 

[0 0 2 5] »*3S9E«Ol8Wfc*oTtt % SMe»J«l 
77xA©AtfJ£fr£3M35©^»£if£-t3 



(5) 1$BS2 0 0 2-2 9 4 3 7 

8 

gBft\ *7+f-^££Dffi££tifcftahrt'7£fT^ 
■fU+'a 7-7^<D7-i'- F^>y7«i:$na 0 C©8fi 

*s 9 mm<DfflBT»m % m$« 1 mm<D% 
mmk%m<T&zttf-e2z&iz&z 0 tctcu mm 

Aa£ft3flah;l/7«*T5}8T7*-F>^7«tfU 
^7-7F f 3{C#a-ra/ci6T'Sa 0 $fc, /N7F;1/tf 

[0 0 2 6] Mt|| OEKOSWtcSoTtt, *7tf 
-^^6©ffl^O 1 OT*Sa^ah;l/7«^ffi<D^t$ 
*S!llfi-rsy5'y^A\ *7«f-/S£7#;iU-7£© 

v 7«ai f**/hs vMitfii-p c fc «t o ev>fHSR% 

£JST?*fc. kfL 7^-K/W7&i&#V< 6'Jn;*< 
Tfe, F7^*frAtffc£ft/-cl§3\ anwtttna*! 

20 5o Ctlttx F^l'^^A^S67U773 7fc^tC 
^ah;U7fcLT«^LTL$5rc4i)T^5o fcfcU 

JS867 y 7 7 3 yit F5 7 m^a t o , msew± 
^ah;i/7?|{gfcy5-y7^ifrc-& 

«ci:t«tt), «W67y77 3 7*ffi«Loo, F77 

/ ^ a*ss t -r a sej w**««-r a c i: *^h6 t a 

[0 0 2 7] 

30 [«WO*MSOmHI] (*JS©«»1) 

[0028] nm<D&m 1 uai^g 1 , 2 

[0029] its MMis L®£tmmzm.m?z 
t. mi itntmmmmmRttircmm^tn 
mm, ®2imm&®.m®ms%7r;tm$Lm-?&%o 1 

14 Xf 7 y 7 7*^7 -;l/T'fe 0 v C ©E|g^ (i37A-> 
+ 7 h 2^^LTXx7U>7*4 ? -\ , 3tfix.e,n, 0^ 
7x7'J>'7*^-\'3F , 3<D^-)/7^*rii-r§ 

ztK&vimtHtttetiz Uf-7y>7*««fcffl 

40 . 

[0 0 3 0] 4ti^77^aX-7T*fet), t~7 5 
t N zi7A7+7h2^1gttP,tlg»)^teft'tONi:a 

[0031] stinyha-^ mmm^mm^) 

V&Q, 37A7+7h205lHl^^tB-raD-7yx 

7^-7^9 (»se^igfii^w#S{i:<as) frzcomftm 
50 5><d<i# (ffSAtf, itssft^, m^a«jia««fii§) > 



9 

[0032] M®®<D±&Mi&zmm?%t, m3te? 
i: , m^mmc mm^mtm^y u * 3 ymm® 8 3 

[0 0 3 3] *7^f-^8 1 C«ia*RWrSfc, 04 

b, c. DttSMas^ a-wte-^yK 

1. 2%, Hl-6C^ra3. 4T»lSIEtT*^if-/^ 
^©^©A, B, C, D©fr5!l*$3. KeO^g 

[0 0 3 4] l/^aU-^8 2©lMit5t, U 
^1/^8 2 ©0!l£0 1 6 CDS 5 IC&To &#&!©£ 
»7-f-h*Ai.^O^ G£5*©k l~k 

7) ©a^fttt, mz.ii, tm2%Bamm§SL<Dim 

win of&Km&&mptffitEU mmommmmmm 
^■p**«jfiTttav\ cn^HB-rs^tLT, eg 

•To 3 6*© a &tfa> £?\ ass 

=t<omwt v p t-rs,, dcD/-H7y^jfim^6 

©jfi<ttfcBSfi:Hi 7©H«37. 8£f#3„ cintck 

[0035] mt7 Vtisa VWNR 8 3 ©HUStcov* 
^R««*tH*nS. CCT, signOtt, A*Q#IE©t§ 

□ i £\ a©«^tt-i*» «©^tio^ai*-r5o 

2T?«\ t-^ffftl«lS I .totals 



(6) ^2 0 0 2-2 9 4 3 7 

10 

K/^ 7 *#©J§*fr®ftffi I _fbt , -j£©»te7 <J £ f 

a yg^fiiwtcffl^-rs^^fiiR * W/N A * K T 

[0 0 3 6] t*t>^, Jiie7'J*S/3^*aB£L4^ 
-emWt£tlfc7J- F>W *#©J&fr*«tfi I _fb£ % 

T^inATt-^ffliirttifti.totai^ittusns. 
[0037] z<Dm&<ommiv&, mm&ft 

& © 7 -r - f ^ v * &mm&n&ti t %^ tm^L-zm 
20 iMkwm-£74 - Frtyttzztw^mmTit, 

fv < "j i <m&>b z<tzz.t&T*z, f^y h')it>m < 

F5-r^©^j>A^fF^-r5ci:^T$5©T' 
30 [0 0 3 8] HJfi©Jg88 1 "Ptt, 7-C-FA.y^ 

ftvmfmmm i _fbtcjjpx^^)K7 ^~>3 >*a^» 

©J§^t8SfflR*W/NA*KTO^|Rl*, £Mg^iS5 
©l^tiOftSSJIie^lqlfclBIC^fcLTV^fe 
i6> *M67 * 3 7 Y - F 7 * 7- F T'M«1" 

[0 0 3 9] ^6>tc, n>hD-7 8^ ->XfAff)A 

Pi©«fiMlcStJ#Mtti>©7^ - F^y 

8 3fcJ;9«tlSSn*fe«>, *7tf-M8 1 tU^ab 
-^8 2fcti, 7Y-F/^'y^ff«*/hS<"r*^T? 
^*©$ StU JM67 U ^ 3 y?i{«gP 8 3 *iilinf 
S i: v> 3 ®^*«fig©^Mfc j; o % $JgiiSei4^Slif 
Loo, F^^/tcoii^A^^-rsct^T^^o 
[0 0 4 0] (^«©«||2) 

[00 4 l]m*^3. 4, 5Ett©fSlifc:*fJSrS§l 

167 y ^ a >M«gp 8 3 WKtt, ^SS©0^ l i: ra i; 

50 T'feS ©T\ Ji8£7 U ^ 3/ 3 >?S«gI5 8 3 W^-OSiWtt 



11 

[0042] mm<DBm 2 ic&ifzmm? y * a ym 

{iSP8 3<D<ifi£fco^T, B6t^»J»7n-lt:J:0 

«£-r3A*iui:;*n3o xfyy6RB, A^mc 

signOtt, \1iWJE<JM£ 1 2\ 1 * % 

*O«^tt0*tfl*fS. Sft, X(0)<D(0)tt8aEffi* 

*->y^<BYA^tH^n5o a*, toa^ysniY 10 

(X(0) = = X(D) 14, X(O) = X(l)0tt&ttK X 
(0)*X(l)(OlS^40i:**i5. X7-y76 3TW:, * 
9y*<IY<D«AfiiI> 3-WH?SSfto 
*JBWffia©Wl«Z4i<Xh7Sti«. ft*. (Y(0) 

! =0) tt % Y(0) *0O«^J4l t^nso Xfy^ 

6 4 -pa, issuer y * i/ a >ssffiwo^afflw(o) t 
ffiEfiiogasfiic * z (o)©fu*^7 y *~>3 ymfe 

IW(l)fe?n5. Cilf, C»4ffiIftftT»fe5o 
•y 76 5 T-14, JM^3«lSKffl^flWer * A* Q 20 
SftS. 7*7- y 7 6 6 T-(4, A*Qfc«tDJill6*lft*S 
ffiF^R^IWiSnSo sign()(4, A*lQ#IE 

1 2\ a©i§£{4- 1 S\ *O«^J4 0*tH*f 
3, X7>y76 7T'«\ t-^ffliuWJtl.totalflV. 7 
Y - H / Vy * JB^tatffl I _fbtc \ filEfc «fc y At 
< *ftfc»te7y i«ttW(l)lcffi3T*JS^ 
WMBR * W(l)/N A * K 7%1mz.SZ. tT'BtiiZft 
-So ClT', NAI47*?-aX-*:p-Wfc x KT{4^- 

[0 0 4 3] ±BWIP7D— j^6W63&»ftJ:5fc» Hfi£ 30 

[0044] T&fr^ ^«>s£sn*»i£7y*->3 

>SSfflWtt, At -Tf 5 fcSM67 y * 3 7fi£ffi© 

[0 0 4 5] cfcoT, HS(§<D^fg2T*{4, Sffifcffifrtf 
*KE%fT a C fe. SM67 'J * a 7g£ffiW(l) * 

^167 y 9 =y a y^a^t, ¥M©*eiT38W* e» tifc* 

[0 0 4 6] £43, 3-KHr>U-12lCj:0«WJ 
£\ WSOEfTfcWWU 8Me7y^S/3^S^ftlW* 50 



?f P*S 2002-29437 
12 

At<-T5?liE^fT9J:5tLTtg<, 

[0 0 4 7] 3-WhOS?{tlCj:oT3lf jSC 

fflWU tM67»Jir>73>«S«W***<'r**liE* 

-nws^msm. mmnb&mmm. mmm&&m%tiL 

<fc 0 v Btgfc JM67 y * 3 7g£ttW©ttIEtf & 

[0048] (mm<D&ms) 

[0 0 4 9] gft$«6, 7E«O«Wt»jS1-«^»«0 
Jg^3KlOl,>Ti»Wr5o C0&«<DJBIB3tt, »)K7 

y 7 a >M«gp 8 3 units nm<DBM imv&t> 
3 <dt\ »&7V9i/3 ymvm 8 3 mvmmmm 

[0050] nflio^ig 3 iz&ifzmm? y ^7 3 

^ffJ^fSA^Ut^nSo Xx>y77 lT*t4, A7JU 
{CckyM^^y^fij^-r^JilKftigg^lx^gtH 
$n^o dClT% abs()t4, Artoteftffifcwa-rs. 
X7'y77 2T'fi, UM«liaK©J6Wffl©¥^Wft*# 
$Y*^m?tiSo ^*5> LPFOtt, n-;U7^;l/ 
^^feStJ-To Xx-y77 3T»t4, Jgie7y^^>3>S 

s£<iw©ii£0w(o) tMEfitc * y ©a*«iK7 y ^ 
Zo xx-y77 4T*t4, i«Kftiafi3WMe^isi**ij£-r 

5A7JQt^ti5„ Xx-y77 5TH4, A*QtJ:!3Jft 
^[^^•r^R^Sffi^n-Sc Xx-y77 6T-(4, 
€r-^EPto«^ I _total*V 7-C — FXy ZftV^n 

mm i jbic ffimc <fc y /Jn^ < « ntcm^y y ^ 3 
vs^ffiwcoicffia-rsig^fiafflR * wcd/n a * 

[0 0 5 l] ±IBiaW7a-^6>W6fraJ:5fc. Hffi 
3 S967 'J ^ 3 >S^ffiWcD?iiE«t4, 

[0052] -rt&t>*>. ^»ass*ns*M67y^->3 

7«^fflW^ Atf f § i:^l£7 y ^ v" 3 VSSffiW 
<0^7 'J ^ is 3 >"\«DijX^t4¥$ 5 fe<D©> £j£1£#{g 

[0 0 5 3] ioT, i»l6ftOM>f-7^B5tbfc« 
^ ^167 y tisa ymfeffiWZ'te < -T5?iiE^fta 
C t X\ mkyVZi/a >«SfiW^SM67 'J * ~> a 



(8) 

13 

[0054] sfc, mmmmcomnmmm^m^ 

[0 0 5 5] Zt>lZ. D-/U7 J)l$%&&bZt, & 

^■z&z^yryifttwgkmcmaiT'ZZo fcfc'u 
sm?€z> maty v?ya ymfemvmmy vtya 
y^<D\&mzi%mtffrfr i )?€2>ztic%;'c>. m%v>v io 

[0056] mm<D&m4) 

[0057] mmmsmmvmwicttfotzmncDBm 

x\ m®ty y ? 'y a yi&m.® 8 3 zmvmwirmt 

So 

[0058] mmy y 7 3 ymrn^ 8 3 <ommr. 

7^8 0»t, Xf7 78 l&XfXx-y7'8 2li, H 20 
5 0^X7^5 1 RTSXtv 75 2 £ |5]1iT*£ D 1&BJ3£ 
^UTTSc 7x7^8 0^, 7Y-F^-y7#©^ 

[0059] ?Kt>%. mm<DBm 1 -ea^iK^iPiti:- 
[0060] ioT. usEomn i inwnt<D$jm?# e»n 30 

?1zfa(07J- F/W irftoim^mtftm I .fbi^/afa 

icimic&smimtiimR *w/n a * k t^q^c 
tT\ nm<DBm2<D&oiz. mmyvt-yaymfem 
w# < -r sffiiESrtT 5 <: t * < , wmtomitm*. 

[0061] mm<DBm5) 

[0062] mMmsmmvmmnfc-tznmcD&m 

->3 yam® 8 3Lmit, mmomm 1 tmcx&zv 40 
r\ mm7V?y3 y%sm® 8 3 uLftommm®? 

[0063] m%t7 vtya ymmsa 8 3 commz-D^ 

7^9 5^1?, Xf779 0~Xf7/9 4MXf 
•y7"9 6, 7.-f-y 7°9 7 ti, 06<DXf7/6 0~Xx 
-y 7° 6 4 &l>*7-r-y 7*6 6, Xr7 7°6 7 tnUT'&O 

Q££ftSo 50 



2002-29437 

14 

[0 0 6 4] -t£t>^ mm<DBM2T*imftttmc- 
izvmfey wis s ymmmmcm%-rz>Mfciizm 

[0 0 6 5] ioT, ^SS«D^5Ti±, ^PStCltgW 
fg£Lfcif£, ^7U^>'3yS^filW^t<-r5 
MlE£fT5 c i:T\ U 7~> 3 >M£ffiW(l)tfH 
SI67 U 7 > 3 Mcj£o*£, HM©^^*. e, n/c$ 

<D^H5.Tii, 7^-F>Vy7#<D^*jSitltI_fb£ 
|W)73 ft£ffi«#<of^Sffit<I£irax. 5 X i fc LT 1^3 ft 

ft, *SK0^2cfc'9fe$e[CD^Xhtt<D^«Jilii 
[0 0 6 6] (^M0^6) 

[0 0 6 7] H*«8l2^fgBHt^jS-r5^fiS<Dm«l 
6£O^Tft&BH.-f3 0 CO^figtDff^5«, #S67U^ 

'>3yffi«gP8 3wmi, ^o^,i tni:T^^<o 

T\ itf67 U ^ S/ 3 yMttHP 8 3 JX^OK«H:«l«r 

[006 8] SM67 'J ^ i/3 yffiffltS 8 3 O««lco^ 
T, 01 0fc^fiWffll7P-lcJ:0KW1"So X 
X77°l 0 4^lt^x Xf77*1 0 0~Xf77 J 10 3 
RtfX-r 7 7° l 0 5 , X-r-y 7*1 0 6«, !7©Xr7 
7°7 0~Xf7/'7 ZJkXSKT-v-fl 5, 7.7^77 6 

fcraa^feost^^ns-rs. xf7/io4m 7 

FA-y ^^oiS^BiJSffl I Jb)WiMI-r*lftlfefiriRl 
[0 0 6 9] -f&fo-S, HSSomH2Tli^S673lDl^- 

[0 0 7 0] i^T, HBS0^6T*«, WfeftV'^y 

* y Lkms. mmy u 7 3 >«sffiw*/h 

5 < f 5 MiE^ff d C T\ JSI67 'J 7 ^> 3 yg^ffiW 

3W«il67U 7->3 yicfc-32, mmft<D^y?y>fff 

[0 0 7 1] (*8S©J$B7) 

[0 0 7 2] »#«9lB«©^8fc*fiS-rS^flSO}e!l 
7 KOVTSiflB^S. C©^SS(D}B^7tt, $ffl->Xf 
A©3>tt1t^t-3V^Ttt, 0 1 Rtf 0 2 t^-r^sso^ 
!Bli:ra*Tf*S^ 3>hn-58^ El lt^f 
j;^^, iyXxAOAWTJ (ATJtLT, 77^^x- 

tf N 3-^> «tiig, £Mg^S 



15 

[0 0 7 3] *7V-*8 4<DM$Z*m4 (WffimtL 

TiiRO ickomwtzt. m^pA, b, c, d«-> 

Xr Algol (HpSS*. a-Hft^-^yK ¥ig^ 

fl.SL##J* Lfc A B C DRtfK e ©j^S^T. 0 1 
8K*VfSl OtimgSiiRtfjiKft^p^Ati, gll^ 

aTd^sijg3i©A^ or&fr-^ na) fc-rs««S" 

fc£U 0 4£JitU;?W5>fr&cJ:?t, *7->f-A 
^SSt-S^Xxi^cteymtf^SLfc^ (Si 0©T 

7-tf-/^s?tfftsk©T\ ym^efey^XTigi^ 

ftS-^Ti£&U ftfi*li:iSa*Atl3*>©T&3o 

@i 8©si nc^^aoif?.isv^3fiftcr?.-^ 
$-*\ jinenaofisisv^fifiTdoA^-s-pjajiB^ 

U >Offi*lf*BTd0fc«A"r5o £ 
->a y*^5t^-e*S*V 1 «>t i!OgS**St«*A^ 
T*«f5o *©H»*vtdtr*. c©#7y>ifi<K 
*Lfr l lOiSffiltS-Ti:, Si 2fcSl 3©Sg&S£ 
f#3o ctuc*0 A&tfa)©#»£&ST*2So Si l 
%Sl 0£S2lcftAU 01 9^-TSl 4£Sl 5 
*t#S„ Si 4. 1 5*WELT*7*'1f-/<8 4©«iR 
tpKfettS ABC D<D'm\*%Z>o K e ©$£?£ 

ABC Dff5>J^5ttSStlS*V ^«*BS-r§o 
[0 0 7 4] 5 OttftftftOTS U 

8 5 ©0J£0 1 9 ©S 1 6 K^l" » &tf!i© 
Sa7-f-K/V^<D^ (Si 6 4«©k 1~ 

k7) ©ftjaStt, 0IR{f> M0g2^£ffffiHR4)ft 

awttwosftT^s. *©»£©ff!i*3vr. si 4^ 

W»*»**'r3S-e**36l<, MffttftQ Aft t #J»«T» 
*S«Wi©fl!ltcil!ttft*p*^U ii«©«iiW» 40 

f6iap«tiw© ->xf a© as/ xtwkis ti 5 
-&&T?iSfciu #tMfc»#xns «>©?**. 02 

OtcjjVfSl 7fciBBft*p©JB5l¥v^iS«rS-^ 
S^-To Si 7^© A, Wa), #tt©ifc££*3* 
f„ S1\ M&ft$p©S3^£^p0tf-£T*ji 



#^2002-29437 
16 

y>ifi<tt*ai 7©iSittfcB!f ^02 o©n&s (Si 

8, 1 9) £f#5„ ^me=fcOAp Rtfco, #ffc£&5£ 
T*t3<> Si 7£Sl 4fcftAU 02 0©S2 0£f# 

[0 0 7 5] ?yhn-7 8<DMl&lC~D^T. 01 2K 

jtse^i 0 tm&MjmmtiLy s tr^fax-^^ 
«Ki fcaeiftsppfi^a^nso xfv7i 2 it* 

ti, *7-f-^8 4£:fc^T, ±E»JMUli£fct£oT 
ttag»tfSi£Sft<&. Xf'V7"l 2 2T*«, Hal/- 
* 8 5 £*3^T, ±iBSSfflS£fcftoTit^Wffitf» 
g£*l3 0 Xf77l 2 3T*fi, Si7^faI-^T 

[0 0 7 6] C©<fc3fc:, ^Jfi©JgH7fc$oTt4, * 

4K«fco«i£2nfc^ah;i/^*fi-6ifi-ru4 J au-^ 

LTli, Xr7'Jy^«»lfcA*Sn*^-ah;P^*fir 
[0 0 7 7] (£ffi©J$!88) 

[0 0 7 8] H*JI 1 0E«O«WfcJ*)S^-«^«S©Jg 

ftsfc^vTStW-fSo c©^SS©^S8tt, $M~>x 
r A©^^figtOl/>T«, 0 1 RtfB 2 t^-f^SS© 
Jgffil a>hn-78^ 01 3K^ 

t7^f-ax-^A*-e*«*j«UB < WR«ffi«jiai-r* 

l^n.U-2 8 5* i:, ^7lf-^8 4i:^aU-^ 

8 5* i:©iH»cKij-5n» *7if-^8 4^e.©tH7j© 
*8 eiz&vm&znz* 

[0 0 7 9] 3yhD-^8©<ifiEtCOV»T. 0 1 4K 

^■riw»7D-Kj:oaitta"r«. xr^7i 40m 
wot 1 t.ms&@impt>mfr&£ti&o xf-^i 4 it* 

ttx *7*f-^8 4KftV^ ±E^SMa?S^oT 

vmm&mmztiZo x7 7 7 1 4 2 t*«, us-y^s 

6tfeV>T, iWe^aTdOtiWfi^US'y^ffiTdO* 
S^^V^^tC^JPS^tlSo O$0, Td>TdOSfct± 
T d <-TdO©l${;:ttT d = TdO^fctt T d =- TdOt 
^tlSo Xx>v7l 4 3fli, l/*al/-^8 5^Cfel/^ 

t, ±Eta»fflaffiKttoTig^t«E3yawsns. * 

fe, l/+"al/-?8 5' ©fllfigMS, 0 2O©S2 HC 



(10) 

17 

[0 0 8 0] £<D£olc^ ^mo>BBSK$)-oXli, * 
7f-^8 4 fc«fc 0Xf7'J y*Ti«§fc:A*)24a3fl-Sl 

h/i^*fti£2fu fl-SLh^fiiffigptf, *7-*f-A8 
4 om^n/^a hjitztt^ffitu** is-* 

8 5' rtC^-f-KA-y^i^tU *7-9-*-^8 4fr 
6<Dtti7J© 1 OT*fe5ftah/U£$£ffi©Ail2£frJRg 
T5'J5>V*8 6£, :*7-f-/S8 4 t U^aU-^8 

5* tcoc^tt/cfc^ ^ssojg^7iipi$K, mm 10 

U *DAT, S^U^^ay^ffllLoo, F^A 
[0 0 8 1] f ^5IO^H8T'tt, 7-f-K-K 

?iWAt<4oTL$v\ ftAfcft&tfSSGlfcftffl 

* i«£#ffi£{§W± £ & •=> fdS^tt* F / WAJJlfl 
oo x Fv^M^A^^fc-rsSiJ^^fig-rsci: 

[0082] mvnmomm) 

[0 0 8 3] JK±, HSfcOJgfi 1 ~HSSO}Btg8 KJ: "3 
#f8l8*BHI!LTtfctf. R#WafllritH:cti6©*ai 30 
©JB^fcRSftS TfB©*SMI3©Ilg* 

- F^y ^It «fc 9 Xr7 U y ^a*tS8» Sftfc 
Sflah;l/2ffi«»*IS:tt, fro, HW6#J»^ao7-f 

[0 l ] %M<DBM 1 (c43^S««igti£«Ifl^lB«Siffi 40 

[02] ussojBisi ic*ijs¥«Kisti6ij»««fft>tia 

[03] nffi<DBM\ <D=iyhu-7%7F?MW7ny 

im 4 ] nmv&m 1 ©*7+r-/s£jjvr $yep7o -y ^ 

0T-&3„ 

[0 5] llfitOJBIBllcfeitSnyhD— 5©JM67U 



#Ht12 0 0 2-2 9 4 3 7 
18 

^>3 >i§m®-e<D$m7u-*mtm-e&Zo 

[06] *JHi©«||2lcfettS3yhn— 7<D*I67'; 
[07] HJfiOJg»3Ki3tt5=iyhD— 50JM67U 

^>3 >ffi«ffiT»©sj»7D-s^-rH-p*5o 

[08] ^lfiS©JBI84 tfeitsa> ho— 50JM67U 
7^3 >«««9JTO«!lflP7n-*^-ria-e**o 

[09] iijg©^®5 ttittsny ho— y<Dmmy V 

[010] |feS6©^886K:*»S3yhn— 70SM67 
U >?f«fflT<DiHW7n-*^-rHT*S. 

[011] ^wi7<D3yhD-7^tai7'D 

[012] ^BS©^®7fc*lt5o>ho— 7T*0» 
7O-^f0T*fe5o 

[013] ^iOii 8 On y h n-^^tW^n 
•y^0T*fe3„ 

[014] mm<D&m8fcisi<fZ3vhti— y-emm 
[015] nffivmm i <DMWx-m^rc3. 1 ^-tht 
[0i6] mm<DBm 1 ©syfi-ejai^fca 2-^5 

t0T-&<5„ 

[01 7] mmo)Bmi<DmmT*m^cjS.6~3.9tt* 

[018] H«S©^!B2 0SWB-efflv^cai 0~iU 3 

[019] H«OJBSl2©SiWeffll/^ciCl 4~Sl 6 

[02 0] *S6<0«!l2O||iWefflV>feSl 7-S2 1 
£^t0T£-5o 

1 7,7-7 VZ/?*4-A, 

2 3 

3 7r7'J>m 

4 iir^ii-^ 

5 * 

6 «B&^>y^ 

7 "WMSSMI 

8 nyvu-y OMSHtP^gD 

9 o-^Uxyo-^9 0M£*IMHftttl¥&) 

10 CCDA^y 

1 1 measgfi 

1 2 a-Wh-fey-9- 

8 1 *7*f-/S 
8 2 

8 3 JM67 Uf-> 3 yffi{«g|5 (^a h ;l/*fg«ffi) 



(11) 



'ftM2 0 0 2-2 9 4 3 7 



[01] 



[02] 




if 



[05] 

( START ) 
t 



R=sign(Q) 



L_total=l_fb+ 
R*W/NA*KT 



STARTS* 



I 



MAS 



[04] 



J** 



82 



-83 



3- 



.50 



.51 



.52 



saw 



-81 



rf 



Ke 



[06] 

C START ) 



I 



X(O)-slgnflJ) 



I 



60 



.61 



[07] 



START 

x 



X=abs(U) 



62 



Y(0)«(X(0)=-X{1 ))*(Y(1 )+1 ) 

T 



r 



y 



70 



71 



Y=LPF(X) 



2(0)°CY(0)— 0)*Y(1 )+(Y(0)!«0)*Z<1 ) 

3=— ? 



IT 



63 



X 



W(1)=W(0)+C*Y 



W(1)=W(0>+C*2(0) 



I 



1 



R=slgn(Q) 



65 



66 



fft*M9E&-»Q 



R=sign(Q) 



72 



73 



74 



75 



Ltotal=LftH-R*W(l )/NA*KT 



76 



X 



START^R& 



67 



LtDtal=LftH-R*W(1 )/IMA*KT 

1 

C STARTERS ) 



T 



&m 2 0 0 2 - 2 9 4 3 7 



[08] 

( START j 80 



Ufb-*Q 



.81 



R=a"gn(Q) 



J 



82 



Ltotal = L_fb4-R*W/NA*KT 



STARTERS 



[09] 

START ) 
i 



90 



I 



r 



| X(0)=sIgn(U) 
1 



.91 



Y(0)«(X(0)~X(1))*<Y(1)+1) 



I 



Z(0)=(Y{0)-«0)*Y(1 )+{Y(0)!=0)*Z{1 ) 



T 



W(1)=W(0>+C*Z(0) 



✓ 94 



L_fb-Q 



I 



95 



R=sIgn(Q) 



96 



Ltotal=l_ftM-R*W(1 )/NA*KT 



r 



92 



✓ 93 



.97 



STARTERS 



m \ o] 



[Bin 



( START ) 



r 



,100 



X=abs(U) 



X 



Y=LPF(X) 



W(1)=W(0)+C*Y 



R=sign(Q) 



.101 



.102 



103 



/1 04 



.105 



Ltotal =L_fb+R*W(l)/NA*KT 



r 



,106 



STARTS* 



imi 2] 



5 



1/ 



84 



85 



t 120 



( STARTERS ) 



lj- 23 



(13) 



200 2-29437 



[01 3] 



[014] 



if 
I 



^84 



ZX 

U 
I 



86 



C5t1] 



[01 5] 



5 




ananas 0 0 ai« 




* 




0 


0 








1 0 0 0 0 0 








0 


-V 










aaiSaz ass 0 0 Sbe 




9cr 




0 


-V s 




I 


ytr 










+ 






• 






0 0 1 0 0 0 




Mt 




0 


0 




0 






£bi 3x2 atsa 0 ass asa 








bsi 


0 










0 0 0 0 1 0 




0 




0 


0 





yen Be^xciWsmMM^jfiWSS 



a,e= 

IN 



vr 



» a " vi — L 



mV 
N 



N 



* mV 

mN 

a* =,^22- 
N 



G+C, 



Sm N. 



C, : 8«&3«ty>*- A" 9(Htt#) 
V: 

N«: 7*fex-*rtJt 



n : xfjyyy tit 



C START j 

I 140 



B ,ys,i, p 



85' 



141 



142 



lf(Td>TdO) 
TdU-TdO; 
ise if(Td<-TdO) 
TdJ=-TdO; 

else 
TdJ=Td; 



143 



144 



( STARTLES* ) 



[01 6] 



[5t2] mtt&i 



y- p o. o i o o f 




*:£ u y. : iro a«£**s«a: 



[33] =t*J£*ffct 
x=Ax+Bu 

y-Cx+Du 



1= [ICKiKj^KsKsKr]- 



2002-29437 



[01 7] 

K7] 
[3*8] 

[5*9] 3fSffl®€^«i:^^«Bfi^g^ 



? 




an an as 0 0 aie o 






0 




0 






1 0 0 0 0 0 -v 






0 




0 


?cr 




an au an 0 0 a** -v* 


ycr 




0 


.1+ 


0 


Vfcr 






+ 








0 0 1 0 0 0 0 






0 




0 






a«i a« Bsa 0 a$s a&a 0 






bs. 




0 






0 0 0 0 1 0 0 






0 




0 






0 0 0 0 0 0 -a_ 






p. 




CO 







anauati 0 


ai« 




i 




0 


0 




0 






10 0 0 


0 0 








0 


-v 








0 


ycr 




ante an o 


0 ase 




Ycr 




0 


-V 2 




1 




0 


Vfcr 








• 




+ 






• 




+ 






0 0 10 


0 0 




Mr 




0 


0 




P 




0 


8 




an an a» 0 


3ss asa 




& 




bit 


0 








es 


8 




0 0 0 0 


1 0 




8 




0 


0 




0 



• Td 



fc£U Td:*ttfc#& ei.-1/Jn, 
tettSIM 

K11] 

fd— A-Td+w 

cstiz] 

U13] 

«©5m=2ATdi 



(15) 



&ffl 2 0 0 2 - 2 9 4 3 7 



[01 9] 



120] 



[SCI 7] 



$ 




an a^ai j 0 


0 ai6 o 


I 




0 0 




0 






10 0 0 


0 0 0 






0 -v 








0 






aiiauan 0 


0 a* 0 


ycr 




0 -v ! 




i 




0 


ytr 










+ 




* 




+ 






0 0 10 


0 0 0 


>tr 




0 0 




P 




0 






a$i as a» 0 




<J 




bsi 0 








0 






0 0 0 0 


1 0 0 






0 0 




1 






0 0 0 0 


0 0 -A_ 


Td 




0 0 







0 

x«Ax+Bu+T ■ 



[5C15] 



r Mo oo ooi o] 

1*1 lo Q. 0 1 0 0 O 



y=Cx+Du 
[2*16] 



[o 0 



raia] 

Xp~2v p 



[3*20] 



* 




anaii an 0 


0 a» 0 0 




i 




0 




0 0 






10 0 0 


0 0 0 -v 




*r 




0 




0 0 


S?cr 




anas* au 0 


0 ass 0 -v* 




Ycr 




0 


•1+ 


0 0 


Mr 




















0 0 10 


0 0 0 0 




Vex 




0 




0 0 


§ 




asi a» aa 0 


aa au as* 0 




& 




bsi 




0 0 


a 




0 0 0 0 


10 0 0 




0 




0 




0 0 


Td 




0 0 0 0 


0 0 -A 0 




Td 




0 




1 0 


_P_ 




0 0 0 0 


0 0 0^/5. 








0 




0 1 



[5t21] 

1= 00 K.K»K. KsKiK,]- [* *t fcr Jfcr 6 6 "H.O fl' 



(5l)Int.Cl.' f$S'JI2^ FI t-V3-K(#%) 

B6 2D 131:00 B6 2D 131:00 

133:00 133:00 

137:00 137:00 

F £-A(##) 3D032 CC20 DA03 DA09 DA23 DA29 
DA33 DA50 DA64 DA84 DA88 
DB01 DB11 DC31 DD02 DDI 7 
EC23 EC34 CG01 
3D033 CA12 CA13 CA17 CA19 CA20 
CA21 



